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(54) WALKING POSTURE GENERATION DEVICE FOR LEG TYPE MOVING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide appropriate ;g §f*P) 
steps and rotational angles by providing a walking 
posture generation means which performs approximate 
calculation of requirements on the walking attitude 
based on a selected standard walking posture and 
generates an approximate walking posture for satisfying 
the requirements on the walking posture. 
SOLUTION: A standard walking posture data group 
which is prepared on off-line is stored in a ROM 

beforehand (S10). Secondly, an end upper body position | :^fg 

and speed of each standard walking posture are found so 
as to be stored (S12). A timer value (t) is set to 0 (S14) 

so that interruption of the timer is waited (S18). Thirdly, - ■• ■ ■ . 

a changing point of the walking posture is judged and 
when it is affirmative, the timer is reset (S20) and a 
requirement value to the walking posture is read (S24). 
Fourthly, generation processing of the walking attitude is r 
implemented (S26). Fifthly, the walking posture <QEO 
generation parameter is substituted (S28) for a target 

walking posture parameter and an instantaneous value of the target walking posture is 
calculated (S30). Sixthly, the time (t) is renewed (S32) by At. Both-leg compliance is provided 
based on the walking posture generated thereby, a target joint angle is found, and the robot is 
driven and controlled for the target value. 
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©firg • ^l^tiS 3 CC^RT<fc ^ tC. ±{*©{>ig • 
j^S¥©(4g • . 
f(t) : ZMPi(iji?rIB^-r5M^ ( C ©K^©(B«mrf2 
40 ©Ao<. B#gijt«:*iWSZMP©fiiS(x,v,z)*« 

-f ) . 

[0069] * tc^mmt^ *sss o r ta-^ 

^mmiCTT.t /cacck^/s^ ^ - ^ ^w^wtc^iaT 
^#-c*s*^ '<7^-£©«ffltt#£(ciH>(D'e. « 

©«ie*ffl^-2.c<t<fr-5. 

q( t: a. b, c, d, x(k), y(k)) : a86fljE£!Ba>T<b 
SO HSJt 
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f( t: a, b. c, d): ZMP#liI£f2i$-r£liaa (JSfcJS 
(IU 

a : wmmms.^i^ 

b : vmmm&wmiitM. (#«> 

c : K"P3t^©ZMP<DXffi^ 
d : ttW£8#§©ZMP©Yffi*i 
x(k) : ±»tiLlB.<!>X®M*%m 

[0070] c <Dm?.-ci<t. &fmmt>-m<D'^ j - # 10 

©i§|gtB$iai3g|||©fc«>K: t ±(*{4g©B#m?»Jf— 

[oo7i] c<Dmm<mm-viz> mm±w&m. ■ &a 

[0 07 2 ] CCDHJfiO^JS{C*Jl»'C»t5i|I^Si U 
7 7 >tf tfiMU tfe < Ai, WT3 

^0«»^ 

q( t: aO, bO, cO, dO, xO(k) , yO(k)) 
f( t: aO, bO. cO, dO) 

m 1 

q( t: al, bO, d, dl, xl(k), yl(k)) 30 
f( t: al, bO, cl, dl) 

q( t: aO, b2 , c2, d2, x2(k), y2(k)) 
f( t: aO, b2, c2, d2) 

[0073] cti^nm^&omimm&w-iiiM. ■ mm 
tmsnBm&y-iiia. • s^«ct*. 0 5 urn 1 1 tc 

[0 07 4] 04 7a- • ^-p- KDUiWCCA-Smrtc. 40 

e titc t l . ±te l> tcmm&®fr h m z& 

Sb 3*#o.. 
[0075]§E ^3^g©/^y-^a©(ii«a 
3. b©{Ittb 3-C&S. ra^li. #!§©&#&}SSfcT 
<£^>k:. ^lOA^y-Jc, d*jJ;i>'T---7';Ux so 
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(k), v(k)£apH«:&5£-r&avC&£. 
[0 07 6 ] ^Ct, 03*£g£ 
q( t: a3. b3, c3, d3, x3Ck), y3(k)) 
f( t: a3, b3, c3, d3) 

<bfc#. 'UJ-ttcl, d34aJ:0'B#^Jf— ^;Ux3Ck), 
y3(k)£ifc^-rS. 

[0 07 7] CCT\ fflfg^g-TSi, ;-?7^-*a 
fcJcO'btt. C©££attff©fl.gC (*~si,-jr©i*a -Y 
-r ? * 6 2 )&t*©^«:«J:6) $/c««iJ©$|g <S 

£') A^c©gg{c*tors*g:Sffl (MBLfc 
7 X - £ t Pf 

[0078] c<D$mmzm-cizmji<Dffimit(Dtc&, 
anst©^ ^^./c 

1) *^u-**>e>©Ji7n («£li]fta*J<fc^ftiISJg 

2) ft©filg|g (fliigfSlggfti') *»Wfc»£. 
^*i#>«=>©g3<: (*»^liJ«IJS^{4S • ©ffe 
K. 

3) ij*$J;0 £ /$?c«^©^S<k©«^fr (flMLbtt 

St£#-Ci*&„ 3) {Cot,»r«^4©^]IS©^SS-Cft4 
ft*. 

[0 0 7 9 ] ^ftfCStU «7^-$c, dte<fcO'f-- 
^x(k), vck)©^^^. ffi&ta:5£^^-*©<iIK:ie; 

citeg&Tiiot,*©-*?, mmny—^^mMw^.^ 
=y * - $ t tt z> c t ««£ ^^^c t». 

[00 80] g/c. I0»gm©S 1 te«fcO-^2 
Sig^Stt. ISO*§*£#;g£»i£OT. SgggA7 

&©-£>£>£„ C©«fc^(C. j§!l?3nfc# 

[0 08 1 ] CC-C. S^S©^ - ^^-^ (C<DWM 

f^XDtfeM^tSi- g£JS^y-*c3, d3*J 
J;0'S£^B$^jf._ ^;l,x3(k) , y3(k)«. ^-T*l4>. ^ 
S©^ff€rSI/cf fc*CC, a«RffiA^y - * a i b (C 

L<t, cne.©fii«iiiBifl<)«:^ft-rst©i#^6n 

4. 111^, cn^B. J^jt-H at b©iiiKK^-C* 
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P(aO+Aa, bO+Ab) = P(aO, bO) + 5P 
/5 b I (a=aO,b=bO) *Ab- • • jfi(KSC 

SP /5a I (a=aO,b=bO) : a=aO,b=bO-CCDP©a(CM3"-5> 

5P /5b I (a=aO,b=bO) : a=aO,b=bO-C©P©b(C|ig-r<S 



( P(aO+ Aal, bO) - P(a 10 



[0 08 3] M(C, 
5P /5a I (a=aO,b=bO) 
0, bO) ) / Aal 

5P /5b I (a=aO,b=bO) = ( P(aO, b0+ Ab2) - P(a 
0, bO) ) / Ab2 

P(aO+Aa, bO+Ab) = P(aO, bO) 

+ ( P(aO+Aal, bO) - P(aO, bO) )/ Aal* A a 

+ ( P(aO, bO+Ab2) - P(aO, bO) )/Ab2*Ab 



[0 084]$ i <Dmm<DBmitmm2 ^msntc 

fc©-f*«3. f^-r-S$2<DHSa<D^fig(ifi<K^l*^ 20 
[0 08 5] Wl£^<D>*7J*-$<Dl£&jj<DI&W*m 

[0086] a3Aiali a 2 ©rtffliJfC&nWWfl-. J* 

r-accw-»r*iSB 1 ©stings 0©:&<s5#*£jfi 

[0 08 7] tlT{CStJ1^7^-^*jJ;C>'^ST--7*JU 
£35* rsci j <h«5) . 

C3 = c0 + (cl-c0)*(a3-a0)/(ai-a0) 40 
+ ( c2 - cO ) *(b3-bO)/(b2-bO) 

d3 = d0+(dl-d0) * ( a3 - aO ) / ( al - aO ) 
+ C d2 - dO ) * ( b3 - bO ) / ( b2 - bO ) 

x3(k) = xO(k) + ( xlCk) - xO(k) ) * ( a3 - aO ) 

/(al-aO)+( x2(k) - xO(k) ) *( b3 - bO ) / 

( b2 - bO ) 

V3(k) = yO(k) + ( yl(k) - yO(k) ) * ( a3 - aO ) 
/(al-aO) + ( y2(k) - yO(k) ) *( b3 - bO ) / 
( b2 - bO ) 

[0088] ±ie©^nj. &mm^u-zi5j:Vf- so 
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* [0082] m&pfim*frtmim®i-c$>zrj;e > ix. 

/5a I (a=aO,b=bO)*Aa + 5P 
1 

c3 = ( l - ( a3 - aO ) / ( al - aO ) - ( b3 - bO 
) / C b2 - bO ) ) *cO+ C a3 - aO ) / ( al - aO 
)*cl+ ( b3 - bO ) / C b2 - bO )* c2 

ttsK). cO<hcl£c2©{^©ffl# 1 (C&-?-CC>-S©-C\ 

c3«. coicii c2 K^-rsa^^n-en 

(l-(a3-aO)/(al-aO) - ( b3 - bO ) / 

C b2 - bO ) ) 

( a3 - aO ) / ( al - aO ) 

( b3 - bO ) / ( b2 - bO ) 

[ 0 0 8 9 ] ft. feOLhttttB • m&i>fs.wass£^jt 

i z m p 5 j* - * ifimti: zmmt&gi: t> < -oftmVl L 
xmrnw-mtn twit » . m&&n<Dmmimm-gi $ n 

twit*. 

[0 09 0 ] *fc±ftt4B«r^*5»J-f— ^*€»3J£»& 
a^ffttSS^fc-SM-*. fit. f&-el&7 
©**©JB»cHMi5J:5te. »**iSWrZMPBI 

tta%j«a-r* «fc 5<c±«:fiaB*j8yi:fle>«:*«>*j»^«: 

[0 09 1 ] £/cC©<b#. a**j*5t-rsfci!>cc«. 
ti^3n4#«m^§©i»«Ks§*s ! i:.fir*s©t? < & 

[0092] ±ie©#a«c j: o ri^$goM5 y - * 

So 

C0 09 3 ]«T. @47D--?t-F4#il/-CC 
©»5B©ttf^«:«iWr 5 i . S 1 0 V* y 9 A >rf|ERJi 
l/fcWBE«»*«©f s -5'»4ROM8 4 JC^ablBttS 

■&r*i< &©<fc-rs„ #u»-cs 1 2 teat*, g-*©tgsg 
*s©»«±*a«*i «fc tttts rettr 4 . 
[0094] 5fcK:ai--<fcan< . ±#2 4©<aH^imstx 

Ck).y(k) tLXf-7>l'itZtlX^Z>(DX' x MRi*?" 

[0095 1 *lr>T. S 1 4(C^-C$f-f-7fflt*0i 
0 (ir-f-v*^*- hSi*) . S 1 6*ltS 1 8tCit 
*. #^7«fqi&»«^o (S 1 4(Dj>-fv£»51Qc 
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S> . i4©7a- • ^-p- Ktfljltf, 2 0msC£ 

tcjensns. hps. mmmmt2 0msctv$)^, 

[0 09 6] ^"TS2 0K.mA,V^<Dm t )Wt> t ) 
U B£3ti5i*BS2 2fCiIA,-C*-f-7£0&cy-fe 

s 2 4{C3tA,-c#scc>itrsg3jefii (Ht&Wk: 
«4-[5]*fcg©flHgt3:£; < 7 ^ - # ©gjfcffi < mflfi L 
a, b) Zm&i&ti. 

[ 0 0 9 7 ] ^>fS 2 6 K:jIA,-e#§©*g^tttg£?i 
5. 

[0 09810 1 4tt-£(D{1^£^f 1^;U-*> • 7 
P- • 9=- + - hT*-5>„ 

[oo99]ftt, s i o oicte^xmmmMx?*- 

2a, bOfBtfl&gfB (m3#m ©a 3. b3(Ci5<,> 
[0100] ^t»fS 1 0 2tcMA,X±3Z<DmM&M'* 

5&t§£-t?«. /<5y-$ a«coi»r«ii^^Hi l * 

[0 1 0 1 ] (88. &Tfil5©Hte©JI5&r&-<4cfc5 
tC, WSB "J > 9 2 ©*«#±flc 2 4 CCtt^T+ftK/hS 

* 5 #s£T£tStt#m3:£A,£*^fc6&<,>. bp^. 
jir-ecDflfe©^* 9 ^ - * (c {$ i ^ iussr^it & 

[0102] SCoT. *KfflBN£¥ttS • s6»^7^- 
[0103] »i>ts 1 0 4CCj^rB^*#g©ittJ8R 

sx^y-f cce*ffl*f^Ao. s 1 0 6 ttcm/ovma 

<D>^S-9U\m, (5£l > 0C«t«3il^§©S£R^-7 
[0 104] 04iCR££. fc>tS2 8tcMTl^ 
(CftAU S3 0Wl^TS^?f©^B#fii 

<^-iHi*ij®^©<ii) ^nm-r-s. 

[ 0 1 0 5 ] m 1 7 tt*©fHR4ii*Ti^U-?-:x • 7 
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P- • ft - hTAS. 

[0106]ftf, S 2 0 OtCfcti-Cig^^-c^^- 
^tCS-^l^rBfSlJtOZMP^r^di). S2 0 2tC^-C 

l^/^>-*icl^«. mrfB©ti^l5^fflt,»r 

[0107] feH>T S 2 0 4(Cii/^T , B$£iJ t ©MS¥(4 
g • £ B^^J t - A t ©±{4«:*^{4g3i^B#SiJ t © 
±«Mtj3 ft. ^©f^fflkWfcGCfc^/cJ^CC 

isiB#{cffiis-r^sij©m6iicfBt83nr*jo. c©^© 
10 gg£fi*g©iwii£Wb&<,>©-r. ©Bg-rs. 

[0108] m^xs2 0 6icmA,'cmtRLtcmm&® 
(•^-*>fcS^t?) ©B#?ojt©±&&g(ca-3<,>-c&(c 
iE^fc®^ (SCI ) B$#J t ©ig£-*#g±{M< 

[0109] iur@470- •ft-K0S3 2KS 
-3"CB$gij t £A t tci~tW!Ml>> S l 8fcg?-?T_hfe©$& 

[0 1 1 0 ] (so. ±ia©jp< L/r^ofc^if{c»-^t,i 

20 r>x^tft)n. ^xs^mmm^^^h,, smm 

[0 1 1 110187O- - ? + - \- %0MLXffifflzi 

3 0 oxmm^>?'v jT>xm*?m.wfin2tiz>, 
[01 i2ii 1 9u^<Di^m^-r^)v~^ > • 7 
a- • ^ + - h-e&D. S4 0 0tc*jc»r6iA^j-fe>if 

4 4 ©^WfiI?r^jA*. S 4 0 2 icMAsXiktiimft h 
ZMP©H#Jftg (%ft&ftif><&£) S 4 0 4 

icmA,xzMPsm&m.tkbmuxm^ bp*>. -rn^ 

30 l^te^O'msx^j}?*. S 4 0 6 CCjtA/C07n©3Ctc 

fi!^ rs^^fpfi*^*. s 4 0 8 (cji^■cMS ^ p© 
m&GLm. • mm**&tcm , zm.icfccx-?h-?. m 

Z M P {4g £ mfclxj] tpfo&it— SScf -5 . C ©HJiffl 

•r-Bisiiiiora^,, 
[01 1 3 ] Hi 87P- • f t-hicssi, 
s 3 0 2 tcjt^•cJ£^^ag • sg^ (^^y^jr-^zm 

m cc «*: «3 flSIE S £ # «0iE(B ) *i J; c;±mi • *g 
^tcl-J^t^Oi+^vf •( 9 xi%W%ftl,X 1 2 

f@©B8Sj©gtfUiS£isuiiu s 3 0 4icmA,xtm-k 

40 1 1 ©ffl^)*>e>a#7 h 1 *^^£W»r3n-5)£ 
IE? Z>. m>tS3 0 6lCji/l,-C£Mg5£a*§ftg{tiI 

S£$iiffli-r s „ c mm#6Mct<tm 2 vmwmm 8 2 
[01 14] c<Dmm<DBBu±nE<om<mf&Ltc<D 

so -ess. 
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CO 1 1 5 ] «fc»mi/<tt. gm^tzmfiico^xoB: 

T >i> * 4 A £ C t ifi-C S £. 
[0 116] Etc«±ia©$q<t?ii&L/cC<ba>6. $9B> 

-TSCiKJcO. **i6©iMBWttifr£*ttS£(c£iST 10 
[0 1 1 7] ±fe©&<8S^L/cC£-C?ltJ|fi£ 
41-%i>X*m< OiClt^xm 1 <D?H#§£@ 8 0 

San/I ommc&m?Zo kk. «3e&*$£*#g£ 

y*y (ROM84) CD^S^{£^Sli-SC<t*i-Ct 
S. Etc, Si§t4£fi§§£-r-5.©-C. ) *»6 5) * 

m&?z>t£®z. «mi»*ertc. sneers c<t# 

"C#-S„ 20 

co 1 1 8 ] H2 o». comwom 2 ojejko&se 
co 1 19] m2<omm.<DBmnc*s^xit. mm&nt 

tC. rSSl ». i'X7 i ACDtH^^#1±7!)SA^-?'>'^y 

/<5 ^ - £©m{igES^fc9 ©<fe©^*7 ^ - £©g£E 
S (KIT r^gy<5y-3»®Sj <fcl,>9) £5fc£>. -tti 
£ffitvO<7^-*(D^ES (*5WJ^ftt) 30 

C 0 1 2 0 ] J: 0*»WtcW. - £i»fl»*. 

£") **/h«SEEl/fci*K:. -C-O^gWfl* (A>ttV 

*s £ & s ytJbtctt. ffiotseia Wtt-'f 7^->^iM 

JB»< 9 * - £©ig{ifiaE£>fc 0 ©fiERvf 5y- *©g 
EfiiSSf-S. 40 
[0121] WfiOt. m2©HSS©Jg.«{C*Jl> 

-^©MMbfc^-x^^^i'^fflSrs 

(0 1 2 2 ] UttWCCtt. IC*K,»T'<9 
y-*p{C*f-T4-'<-5y-*Q©)SS%Dl (q,p) iiS 
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k#a7 r -^x(k)©®a«:Di (x(k),p) tie^T 
C 0 1 2 3 ] SS2©Ht&©0&CCteW*g##§©£j?X 

[0124] 5fe©^0«lg^«C*iW4^^y-^atC 
»f5^5y-ifcOSgD0(c, a) mitS 
«^§i©re^tt, fcrF©<£5tCft.2>„ (al - aO) 
#(C/h3WUX. T. 
D0(c ,a ) = (cl - cO) / (al - aO) 
D0( d ,a ) = (dl - dO) / (al - aO) 
D0( x(k) ,a ) = (xl(k) - xO(k) ) / (al - aO) 
D0( y(k) ,a ) = (yl(k) - yO(k) ) / (al - aO) 

[ 0 1 2 5 ] HtttC. monmt£®tC*sVZ'i9S-Z 
btcMt5^7>"? c©!&gD0(c. b) £r£t, m 

2mmz®t<Dmmt. tWD^cc&s. g>2 - t>o) 
*5+7>tc/hs^n«. jeacccE-»-c. 

D0(C ,b) = (c2 - cO) / (b2 - bO) 

D0( d ,b) = (d2 - dO) / (b2 - bO) 

D0( x(k) ,b) = (x2(k) - xO(k) ) / (b2 - bO) 

D0( v(k) ,b) = (y2(k) - vO(k) ) / (b2 - bO) 

[0 12 6] mi<Dmifo<DBm<D^ : 7si-Zi<s£v:f-- 

^©^^tccne^A-r^ciccjcf), a?^- 
r^2 j it,^) znz. 

[ 0 1 2 7 ] c3 = cO + D0( c,a )* ( a3 - aO ) 

+ D0( c,b )*( b3 - bO ) 
d3 = dO + D0( d,a )*( a3 - aO ) + D0( d,b 

)*( b3 - bO ) 
x3(k) = xO(k) + D0( x(k) ,a )* ( a3 - aO )+ D 
0( x(k) ,b )*( b3 - bO ) 

V3(k) = yO(k) + D0( y(k) ,a )* ( a3 - aO )+ D 
0( y(k) ,b )* ( b3 - bO ) 
[0 128] ±iE^mm6LXm2 0ya-- ■ * + 

5- * - 2 mm. * tetsor *>- 

ft, S5 0 2#>6S 5 1 4£vm 1 ©HJfi©^iPJ« 

©toa^tforss i 6tcjt#, tmvm&mm&r 

[0 1 2 9 ] 02 1 ^(Di^m^^V-^fl-^-^ • 7 

o- . ^ + _ s 6 o origss:^^^^-^ 

©ffl^^ffitCifil^-^^S^il^L. S60 2(Cji 
^«^*S©iI»»3£-»'J 7 ^ - ^ tC^ffl^f^A U . 

s 6 o 4 fcjt/^T5£2 {cee^raeji^-^y - 

(sa. ±(**¥C4g©n$^jf— -^juti-atcti-mL 
rtm^. ri#s*5^c»©-c. 'im-fzm&fmmaL-* 

[O13O]02O«CIO, S5 1 8*$cfcc/S5 1 0 «r 
iTS52 OtC^t?ai§#S©B?JB#<iI*»fcH-f 
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[ 0 1 3 1] 02 2 te-ZVimZm??? >V-3-> ■ v 
a- • ^1©5ISS<D0SS<!:(rI«{CS 7 

oo^e>s706S -ccDMa^tf ^.rm j:oO:tt© 

{iiS -^^Sm-r^. ft. S7 0 6rti5£2(Dtti<D 
l'Ti2 0 icm-or S 5 2 2 Srigr S 5 0 8 KlRoTW 
[0132] ^2CDH)5S<Dff^«±fe<Dia<^0/cC 

10 

[0133] (10. l2iS^-5>«li^<DiH^-tf^#fti^ 
ifOttSK: <fc oriJ, m 1 OH*S<D^S§K*f-r-5S2 © 

{c*rLr**l0WS«:«tl5Mtl/. ^y-*2gmrtK« 
?K©7£flttMHBII i fcfl; 0 . *eo^jSKtaB»aiH©r 

-* (SaH'^-*-*) ©ffi*B*ot>2#gicfc.5J:5 20 
feasts. 

[0 13 4] C©«fc5«:Lrf^liSL»fc«HI*S«rJ#-,-C 

c^n«. «<t^©^£#if;^-x^£0T©<£# 

st/ctw^y -*cc#fi,r-e© i o/cwawjr-s&ig 
ct-c**) . miommom 

[0 1 3 5 ] M. B2©SSS6©«JBKcfe(,»-C. lAffiffl© 
*§«C>Pfl/'C/<^^-^JS^K{ilfL'C>tB^{C«. 1 30 

>t'J (ROM8 4) ©gfifeffitfrr-SCiasr 

[0136] m*.l,t< D0(c, a),Dl(c, a),D2(c, 
a) ,...Dn(c, a) &m2ffl— fl"C&-5&6«> -e©3F 
&>fiI£D(c, a)il/t, ±i2©^-7^-£SS&£ffiC>fc 
'<5>-^SK:iiW5D0(c, a),Dl(c, a),.. ©ft 
fe«5«CD(c, a)*#ate«*.tfm». 40 

[ 0 1 3 7 ] M2 3 »C©l8W©St3©3IJ6©0!i8£^ 

[0138] *3©SSJ6<0«»«:fct»'CB, JR 1 ©H*fi 
0&BtftW!DWBt&&imi.>&t#tC. »2©HJS© 

[0139] IS 3 ©f|fc©^8§CCfcl:f ££#*£§©£»$ 

[0140] »3<o*it©jg»{c*j(,»rtt. aaa/^,* 
-^©ffl^to^tc^fcor. m.m®M'* ; 7Jt-$<D& 
«*. -»»» i ©ssss©ff*i&©#&T. m*)itm2co so 
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*6S©^S§©^5rffl(,»-C*J6-5>„ BP^. #§©*!-£• 
£. ^><9>-*«K«cj:a«^©J^4flMrr$ 

[0141] aS6«3e^5y-ir©rt©a©K 
Wc»LTtt»l©3Stt©J&J». b©«»«:»l,Ttt» 
2 ©^te©J&SS©#S«rfflt » 4 £ . &3C© <fc 5 tc £ „ 
c3 = c0+ C cl - c0 ) * ( a3 - a0 ) / ( al - a0 ) 

+ DOC c.b )*( b3 - bO ) 
d3 = d0+(dl-d0) * ( a3 - aO ) / (al-a0) 
+ D0( d,b )*( b3 - bO ) 

x3(k) = x0(k) + ( xl(k) - x0(k) ) * ( a3 - aO ) 
/ ( al - aO ) + D0( x(k) ,b )*( b3 - bO ) 
V3(k) = y0(k) + C Vl(k) - y0(k) ) * ( a3 - aO ) 
/ C al - aO ) + D0( y(k) ,b )*( b3 - bO ) 
[0 1 4 2 ] m2 3 4#M0t§SWt^i, S8 0 0K 

®&&im u s 8 o 2 mwa&A^m 1 <Dmm<DBm 

£Rtt©*S®&tflr». S816*>6i247a--ft 
- HcjlA/TS 9 0 0VlMlC*s^-Ci&n<DU&$:ft>>. 
&tc^2 37a— f t-h<DS82 O#>6>02 57Q 
-•ft-hOS1 0 0 0felKKC^-CBIB$|i*|SLffi-r 

5. 

[0143] m3<Dmm<D&mit±s&<Dim< mmbtcc 

tfrh, fi^©3Ste©««£H«©a&»*W-rS. 
[01441126 teC<D§tW<Dm4<Dmm(DBmZjf; 

[0145] mmt£m^mhHz>m-£mm 
&g • jgg^o-rn-sia^^-s©^. &3ig£-*&;g 

©*?iS±{*(ig • j&g£#©il^g©ftj»l±f*{ig • 

isgcc^b-a-s^-s^G-So *cvm4<Dmfa<DBM 

tcLfc. BP*?. fiJJW±ttCi[B-aBe*5«fcCJf»4B±tttfl[« 

•aatefisasje^y-friL-osBu ±<*&b- 

[0146] *©*ffi*Bttr"5t. - jermumum 
3©*»©jB»©*ffi*m»r. »J»!±<*{iB • itftfe 

j; cm«±^a • »a * » < . 5 ^ - * # 

[0147] ^©*5S«fieiI©||ig©^<!:|5IfilT* 

*©-cstt**«wo. «t. »*©»iw±»tiB • as 

[0148] BJfiO^S^J^ffitCfeOT. *7]»3±ftfic 
B-jIS. *SHB±ftttB-aHt**J:O t ZMP/'C9^-dr 

[0 1 49] C©«^ W«J±(*ttS • jiSiZMP/< 
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Kifcsssn*. awe. &®±.#<n.m- jIS^zmp^* 

[0150] KTTS. IftW^ffiWC-rSfc^tCi^© 
sitf^ft <X2F|aj) omhtcVZ^TLZCtfrZi:. 10 

M P ^ £ - >CC 2 {IKU:©^ y - £ rt^ST* 3. 

co i 5 i ] ccm zmpa5>-$©- g5**>-r 
8©«fc5fci95rr*„ 

[0152] cnu. ae«r<z«[ffi©»jBrrffli»*zMP 

>*fflt>5i. ±#©lilM£^©tM£aiS©W3r*|5l 
[0153] 04©*jfe©B/».{C*JC»rZMP-'^y- 

si i <Dnm<DBm& 2>mm2<Dmm<DB 
2 ©m&©j&ag©^& irzMP^y^- £©jg 

/!:. ft. ZMP 'l? J -iKDffilEmiZ. ig^g©±<* 

»»iRfl:*a*©fl[«c f s /c#) tcii^^© zmpa-7 
[oi54]§2 6 %mmi>rm4<Dmm<DBf&om'E 

&t&W-fZt. S 1 1 0 0&cfcl>TS£ifr©Hj5fe©ff^£ 

s 1 1 o 2 icm/*v&mmm&®<D&i%±.&{m. ■ && 
**«&rEttofc». s i i o 4 tca^riUTotta* 

[0 1 5 5 ] 5fc-r. S^S(C*Jt»r ZMP/<7^-$ 40 

[0156] C©£#. 
Rmix(x(k),c )=Ax(k)/Ac 

£&<„ C©Rroix(x(k), c)£ c icttf &xCk)©[ie&?} 

tc. 03 OtCm-TJr^tC, ZMPA 7 j(-^e{CMl/t 
Rmix(x(k) , e )£#«>£,, 

[0157] m2©Hfig©ffJSS«:*jl,^-C«. HbZiZmU 50 
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tc'ivjt-Zlctt-t £xCk)©SSg£5j<«>.5<!:#(C. $fl#j 

> - * i x c k) * & < m&v&m t< 9 * - Z £ 3@g 0 tc . 
-entc^tor. »4©3<g*©«jb-c«:. #;£?©«&&& 
mtm or. as 1/ /t ^ < ^ > - ^ i xck) < ±r ©m' -5 

tf . St 2 ©^te©0^«S2H4 * Mft&frtc u 

[0158] &KS 1 1 0 6CCj!!*. RmixCx(k), c)i 
Rmix(x(k), e)©#J«8&*©flMir©ffl*»6. jS^SftC 

fewszMPA-7^-$c {c*t-r Si&4sa±ttftg©fflie& 

»W«flERmixCXte, cX K^ftaffi©{lflfc&ttjgKR 
mixCVe, c). ZMP^5->*-* e «C»r*»«Lh*{fl[jK 
©dS&fltfHS&RmixCXe, e). ^^±{*jiS©<BSS^W 
JSKRmixCVe, e)5r^(c J;-^-C*«?)-2>„ 

[0159] RmixCXe, c )= RmixCx(ke) , c ) 
RmixCVe, c ) = (Rmix(x(ke) , c ) -Rmix(xCke-l) , c )) 

/ A t 

Rmix(Xe,e) = Rmix(x(ke) , e ) 

RmixCVe, e )= (Rmix(x(ke), e ) - Rmix(x(ke-1), 

e)) /At 

HO. ke : ^*5»J©*a©KW#-^. At : lURMCDXl 
*«*I8I (gtfx^©^>7Vl/B#p^) 
[0160] ^l>rS 1108 (Cat*. #«>fcJ&ga>6 
SIHfJ(riJ*DS3ft*tRin1x0fe, c). 0Hf^2 5>J©3! 
^RmixCXe, e). Sf!2tTlfl 1 ^J©S^7&lRmix(Ve, 
c). Uf2 tf 0 2 7U©3SJR# RmixCVe, e)©2*2ff?ij£ 

[oi6i] gccvcs i i i occat^-cfPisRofcfflnj© 
astT^****. c ©a!tf ?<j©^ i tf » i m<Dsmz, 
♦*«±*fik«xe tctt??>'i5jt-$ com&fttfmm 

RmixCc, Xe). ^2 ff^ 1 ?>J©S^tt. &iaSLH*[i§X 
e (Cx*-r5^7^-5r e©iBSfc^fl«JffliSRmixCe, Xe). 
»lff»2J»J©«JR«. *«Lh#afl[Ve 

> - ^ c ©(BSi^fl«JJffliSR mixCc , Ve). ^2 0 2 ?(J© 

^W.®aRmixCe, Ve)i-rS. 
[0 1 6 2 ] jSS, A6«5>5il^S«:*5ur±fB.®S* s 

llRCc, Xe),RCe, Xe),RCc, Ve),RCe, Ve) il/T. 

[0163] -X^VS 1 1 1 2 CCiiA,-Ci!^£gK:*i<,> 
Ttt«UbfletM{c»BU. Ch/c^i3 1K^tJ:^ 
{CAxOftiW^/jNgW&Stt. •tflCCflJoT. 86^^^ 

^^ris-r^ct ^{cittiigc^^j^-^w^sft^A 
xck)***5. 

AxC0)= AxO 
[0164] C©i#. 
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Rmix(x(k), xO) = Ax(k)/AxO 

&AvOtcttWl'b$mZii> Rmix(x(k), vO)£5j<#>S„ 
[0165] -XiCS 1 1 1 4&Cii# > #©/dSgRmix 
(x(k), x0) iRitiix(xCk), vO) ©^i^cDffimrcOfii 

^±&{4E0(gg&#lW.®gRnrixCXe, xO) . i(&$Sg±#i£ 
^©{If&^tt.i&gRnrixCve, xO) . fTJWiffciagCCfcfT 
£^±#{4g©fliefcftlft!&gRmix(Xe, vO) . Wt± 
<*iig©(i^fi<jS5SRmix(Ve, vO) Sr^S^Cj; itl 10 
AS. 

CO 16 6] RmixCXe, x0)= Rmix(x(ke), xO) 
RmixO/e, xO) = (Rmix(x(ke) , xO) - Rmix(x(ke-1), 
xO)) / A t 

RmixCXe, vO)= Rmix(x(ke), vO) 

RmixCVe, vO) = (Rmix(x(ke) , vO) - RmixCx(ke-l) , 

vO)) /At 

no. ke : mmmwMkBosmm*. At .mm^Kom 

[0 1 6 7 ] ISl>TS 1 1 1 6{Cjt^^^v5rO{C'; 20 
•fe? hOrx#-hSt»\ Sill 8£igrS 1120 

«c^r*-fv«ij&**f5lli/. si i2 2tcitA,r 

*^©tt9#*>9S{C*a*»5jM*rO. WSSn^i 
SttS 1 1 24{CiIA,r# -/7«rO(C!l-fe9 HO. 2U> 

rs 1 1 2 6tca^"Cia«»je^vj<-if©»*ffl*R 

S 1 1 2 8(CjiA,r#S©?i£*tT 5. 
[0 16 8] BP*i. 03 3-9-^;U-^> • 70- • 
-h©S 1 2 0 OlcmA."Cni ttt>0JJI3©SUg©J&!iS 

c ©issue , #mg±&&g • m&*sj:vm&±.#&m • m 30 

[0169] (11/, ^-^SfciSiRO/cfg. ttl»LL» 
fig • ^S*iJ:0*^SSs±(*(4g • ilfiKMl/TW. jSi£ 

[0170] -x^vs 1202 fcj^r^±ft(4g • 

mLmmu£m-i!&®<Dttm±.&&m. ■ met tog** 

©. Cft£AxO,Avo ISMiic. **4&l:#{4g 

• a(£9:*fg£8£$s©*$MLbttttK • mmtomz 

3ftaf>. Ctl?rAXe,AVei-r.5 0 40 
[0171] ^l>tS 1 204 (Cjl^, il^g{C*Jl» 

4S±<*(4S • jIg©gH»SAXse. A VseSr^K J: 0 

AXse= RmixCXe, xO)*AxO+ RmixCXe, vO)*AvO 
AVse= Rnrix(Ve, xO)* A x 0+ RmixCVe, vO)*A 
vO 

[0172] s i 2 o 4<D&mt. tnm±&{iLm ■ mm so 
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«SiRffl{C— Score *§^±(*{4S • itSgJfcfii 
4C©*S©*«(Lh«:fl«.aflti©»a:. AXe +A 
Xse, AVe +AVse"C*S. ^CrS 1 2 0 6(Cii 
<fr. ^©il£0K:^S;fc©©ZMP>'<5'.X : -£©tiIEfi 
Ac. A e oOftfe*. 
Ac = Rmix(c, Xe)*CAXe + AXse)+ RmixCc , 
Ve)*CAVe +AVse) 

Ae =Rmix(e , Xe)*(AXe + AXse)+ Rmix(e , 
Ve)*(AVe +AVse) 

[0 1 7 3 3 ^1>TS 1 2 0 8&C3iA,-CZMP;-;^y- 
fc, e^XStCtotm. 
c = c mix+ A c 
e = emix+A e 

[Bt. cmix:Zg£#§©^-7^-£c©fiI. emix:il^ 

$g©A7>-ji e ©ffirft-s,, 
[0 1 74] ^t,»ria2 67n- • KCRO. S 

1 1 3 0K^rB*U^©'<^-*{C±KB£ifcg 

©^•^y-^4RA-T4. (ML/. ZMP^7^-$c, 

e(Ctt, S 1 2 0 8-C**fc®4fUt4. ^>tS 1 

i 2 2£mTs 1 1 3 2t,cmA,vmm&®<Dmmm*n 

[0 17 5]IWfitC», B34^A-?>-7D- 

•?t-h©Si30 0(c^rS£mi©SI^©jgsgipi 

tt©^ffi-CB»©ZMP£3fc<*>, S 1 302(cMt 
fi£Bfr©^Jfi©^<b[altt©^-cB#^l t ©Sis^©ljig 

• s£i&£#©. s i 3 o 4 ccjtA,r BtiM©±<*{ig 

^sSrsfca!)*,, 

x(k) =xmix(x) + RnrixCx(k) ,c) *Ac + RmixCx 
(k) ,e) * Ae+ Rmix(x(k) ,xO) * AxO+ RmixCxCk) , vO) 

* AvO 

SO. xmix(x) :U'&&n(D±#mMtifmPl<D\i&7 : -- 

±(*eg«x. Y^i$j©ffiiiaifii{cSLttior*>. hmIs© 
comitm^icmmn^-mTW-m or 

[0 1 7 6 3 ±IBO/c^fficcj:^r:f|<$tfKc«:0 2 7 *j 
<fcyl2 9 00 3 2 (CflVT»J&&Sfa£*>ttS C i 

fr*HAfcB«^ft*fiS-rsci3&J-c#*. N. 03 

5 icnrrtftsirtt. 

c<0, c+Ac<0. e<0, e+Ae>0 
it/fc. 

[0 1 7 7 3 *4©Safc©»»B±8E©*P< aWEl/fe© 

r. $g€Btt*o>;7 > 'i'* -f Atc^-rsi^cc. * 
^S$tiA:^l5]±©^«:tec>rasK9 h©&SBfik©£ 

[0 1 7 83 036 »C©Afn©95 ©ldd©01B«^ 

[01793 jfe©m4©H«6©»®r«. il^stcfc 
W & Z M P A 7 ^ - * c tc*f T 4 ±(*teSB$*5»J©(B?» 
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:9tf«&gRmix(x(k), c). ZMP^7>-* efCfcff -2> 
±(*(4SB#^J©<S^5>fi«J)®gRnrix(x(k), e). »J#i± 

(k), xO) . »3W±(*iiK(C»-rS±<*{4gB$3S?lJ«Dffl 
Sft»6 < J®ffiRniix(x(k). vO) £jm>T<,>/c. ^fetf. Z 

[0 1 8 0 3 Hf5©HS£©ff2lg-Ctt. ^©ftfcOtC. Jgl 
TCSTi^n^n^-,-!- ©«W58fB&«tf;3s-=e f\»l< ( Z 

CO 1 8 1) feTBc, C<D^&<DW*Mm*Wi*R-?Z>. 
ft. «T©SW»"C«LhfW*Ifr«!: Z M P iJlit©iffig:£[6j 

(x^raj) j&7}tco<,>T©^Hf&TS#> (y 

[0182] D*? h 1©±#2 4©Mfi*5-entW© 

ZMPO^SJiJCStf S±f*{4g- iIK©S»fr© 20 
<> c©^juk&oT«^j£2 2 a 

[0183] dxmdl/dt=v 
dvmdl/dt =coO* (xmdl - ZMPmdl) 
CCT, xmdlttlS^SjS^cm^&g. vntflKiSO^n 
3zJgT-<D*^jlS-CS)S<, gfcGoOWaEOSfJrr&i). 

"3. 30 
a>0=V~ (g /h) 

[0184] ±is#^fr*5fSfi:uri^»^c«. gg 
4 ©*ig©jf^{cte w ^-^©Wc^Stttt^^^e^JU 

Rmix(x(k), c) , Rmix(x(k), e), Rmix(x(k), x0),R 

tnix(x(k), vO^ftbOtC. ifao/c^asdi^^f 1 

xmdl(t) . vmdl(t) 

[0 1 8 5 ] ±.iZZffimtUXm3 67C3- • h 40 

*#j®ixr«iwr&. ft. zmpa *->©$;§«:. m 

4 ©mss©^ £ ih-kt .*,„ 

[oi86] s i 4 o o {cfct^-csm^s^teti 
i/Tfc^. s i 4 o 2 K^r&«i£*ij:g©ji*ig±&{4 

5 • jlg£3fc#>TiBti.l>fcf&. S 1 4 0 4 Kit*. ZM 
P^-7^-£©|*rCc ieic = 1 . e = 0. $fcp 
(S3 5{C^f<fc ; 5CCB#S"JOCCfc^SZMP©(ii) = 

o, -e-©f6©*f*r'©ZMP©ii4o. ti)Mt%&&xo= 
o . vo= o t u . &®<Dfeffi&fm$-emmw}jj¥*:7 : )\' 

©fttiimi/, ****** JUttKXe. fcW^JUOiSVe 50 
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[0187] ft&fttCtt, 02 9(C*JWSAc4 1 tCfft 
3t L. fc £ # © A c (C <£ 6 Z M P ; < if - >|$ jEfifc * fJU 
A# £ t, r *-r JU©^8&*f#. * 7*JUtt*l4ft&*3tti>. 
i&O-C Z M P^-7 ^ - * c tC*tT Ste^T^MjigXe© 

R(Xe,c) = Xe 

[0188] |i]li&CZMP^7^-£ c (C^t-r-S^-t 
7^UjtgVe©(@e5&?}W!^£#3£(Cj: ^>-C3j<«>S. 
R(Ve,c) = Ve 

[0 1 8 9 ] ft. SHWfc^^^WDJWfcOStfftt. * 

^zmmtuxfrz mxmm &c <t ^ -c## -c nt, > 

[0 1 9 0 ] ^>t?S 1 4 0 6(Cit^. ZMP'^y- 
^©rtTcieic^O, e = 1, £fcp = 0. -?-©{fe 

©fff.^-c© z MPofii o . ti]mvm%xo= o . vo= o 
£gt. ^©i^isms-c. jRi»iti^*^©Pi«( 

5. 

[0191] *l»tZMP^5jf-ji e{C»r*»«* 
R(Xe,e) = Xe 

[0192] HfctcZMP'tv.*-* e«c*tf-r*»»* 
R(Ve,e ) = Ve 

[0 1 9 3 ] ^OTS 1 4 0 8iCM^. ZMPA7)(- 
£©f*J-Cc £ e=Src = 0, e = 0. $fcp = 0. -€-©fl!2 
©*T*-C©ZMP©fii?r0, flJJ8t#!§£xO= 1, v0=0 

£. 

[0194] ^^-cftJW^e^Kigxocc^-rs^*^ 

R(Xe, x0) = Xe 

[0195] |5)«(c. fiBH^^fifflxOKSt-riftFiS* 

^uiiave©^^^.®®^^^;^^ -,r*«>-s„ 

R(Ve, x0) = Ve 

[0 1 9 6 ] ^>tS 1 4 1 0&Cji<&, ZMP'^y- 
5»©rtrc £ e £c = 0, e = 0. *fcp = 0. ^-©fte 
©»T*-C©ZMP©ffl5r0. J>)3»it^^x0= 0 . v0= 1 
£l/-C. ^©^^JSr-. SflUh^fA'Offt 

[0197] ^^-C^W^^JUjaKvOK^fS^*^ 

tv&mt&mekftmm&i'XiK.itc * ■? r s„ 

R(Xe, v0) = Xe 

[0198] mmc. ^^e^juiiiSvotc^-r^^* 

R(Ve, v0) = Ve 

[0 1 9 9 ] 2U>-CS 1 4 1 1 Kit*, c = 0. e = 
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o. p= i . ^©ffe©ST*r©zMP*o. tnmvm* 

xO= 0 . v0= 0 <t L-Ci£®<Df&1%mm$.-C<D&$bJj¥*: 

CO 2 0 0 J ^Ut»fJHgvo cc^-r-s^* 
R(Xe, p) =Xe 

co2oi] -x^-cmm^f^&m.vo (c^-r***^* 

R(Ve, p) =Ve 10 
[0 20 2] A^VS 1412 tCMfr. 3<it>td&m.frt> 

m ivm i n<om$kw r cxe , o . sr i 2 ?u©ggi 

*SR(Xe, e) . Ht2tTJfnyiJ<DgfR**R<ye, c) . ff!2 
fTlS2JiJ©^#R(Ve, e) <D2 * 2tTjiJ£m&-r£. 
[0 20 3] ^>tS 1414 tcM^ itf8.LMffl<D 

cc xe) . mz'nmimommi*. feNK?*Ju&BXe 

(C^-TS^'^y-^eCDiSe&^iSJKRCe, Xe) . 01 
tf^25>J<Dg^«. i^ffl^^UjiSVetcW-r-S^^^ 20 

- a? c ® oMkaftffiffi r (c , ve) , st 2 '<m 2 

WSflER(e, Ve)&rS. 
[0 20 4] XDTS 1 4 1 6"C*-f vfcOiC'J-lz? h 
Orxji->3ti, S14 18. S142 041tS 1 
4 2 2Kja^^SE©W»)e*>») BCC*£*»5jHW 
U SJSSftSiSttS 1 4 3 2tCiitr<!:&«:. 
n5itHS1 424, S 142641tS 1 428(C 

[0 205]i387P--?-i."h^#f,(,t-e©$ 30 
^O^teffi^lftHJ-rSi. S 1 5 0 OlCte^xmWKD 
$m<DBf&<Dl*?tl1J><D^m-CW&&&>* v - £££ 
J3«--5. COit. ««W*jJ:af*«Li:(*ffilB • aas* 

^C^-CS 1 5 0 2fc»^lS^*<fcefi»ifi±fMi 

iSl^iCDMAxO, AvO, AXe, AVe£3fc#)S„ 40 

[0 20 6] HH>T S 1 5 0 4 tCit^. ^JMDVmtiL 
i-ig4AxO,Avoil. ZMP£0 ibfcJi^cD 
teSSfiBS • SSAXse, AVse%^(Cj:«3*ai)S„ 
AXse=R(Xe. x0)* A x 0+ R (Xe, v0)*Av0 
AVse=R(Ve, x0)*Ax0+ R(Ve, v0)*Av0 
[0 2 0 7 ] ^1>TS 1 5 0 6Klji<&. ZMPW- 
*<Dt§iEffiAc, Ae^SCtCfcoT***. 
Ac=R(c, Xe)*(Ax+AXse)+R(c , Ve)* 
(A v+AVse) 

Ae =R(e , Xe)*(Ax + AXse)+R(e , Ve)* 50 
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(A v+AVse) 

[0 20 8 ] :X*.>~CS 1 5 0 8K.&A,VZMP>*7jt- 
$c. e£S 1 2 0 8Vm^tc<D£fflCjK,K.<i:-?X:3}tlt> 
5. it>t@367P-'?t-h©S 1 430, SI 
4 3 2£MT03 9 7D- + - KCjt*. SI 60 
0*jJ;O*S 1 6 0 2-cm4<0H«S©»Sgil^t$©«iS<& 
tf-pTS 1 60 4(Cjl^, ZMP©ioHiiES?:*4?)5 0 
Ctl«, i28(Ctet,^A7^-*c=Ac, e=A 
e. -e-OffiCDSf.^ZMPtDffl^Oib/c^'^-^r* 

[0 20 9 ] 2a>-CS 1 6 06 (Cjt^ ^fMJlWitiLm 
-itfi^ xmcn(0)=Axa vmdl(0)=Av0<!: ZMPmdl 

gijt -a t > (oam. • m&t^ mmt ) ©zmp* 

lei <B*falt ) • itg****. (IU ^©$11® 

fflW}Vte> ^7* fcO^mOQm. • *K£ xmdl(0)=Ax 
0, vmdl(0)=AvO<!:-rS„ ft. 8iiWb£? r rt<C£«, lift 

[0210] -X^VS 1 6 08{Cit^#ie(Cfi!o-C\ 

J: o r @H±{*{ig£3<& S . 

xCk) = xmix(k) + xmdl (kA t) 

(SU x(k) : SULhtttfcE 

xmix(k) : ^l^gCDi^fi^Bf^iJWkg^-^ 

xmdl(kAt) : BSSUkAtCD^f^KiK. 

[021 i ] m5<omm<Dmmit±ii(Dia<mf&Ltcc 

04©^©ff^i^(D^?rf#.5>C<!:*5-C 

[0212] JcOHftWtCJtlt^fiBiaST-^^Uifflt* 
tcCtfrb. J*:<) (ROM8 4 ) <D§g#fifci>-CJS 

0 . M^HJffc fee «fc -»-c*>-r*>&tH«-c >; t;u* -c 

[02 13]fS8. ZMP^-^^-^iC*t-r^^±<${4 
jlg©ffls««^«?{c«fc->r**e.ft.5*5. fg&IW 

[0214] 04 0i*C<DmM<DmG<D^m<Dftm$:m 

[0215] 5tKfcS4ftfc*5. tt^WJS^firg. ^ 
jS>WJ£¥{4g*ffffi6$ti-T*>. ^ ft ic<fc Stated 

■c#5«^« ■r^^ft^zMP*i«<i;^<!:g:^tO)^^l,»i«^ 
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